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ABSTRACT 


The subject of minefield clearance has received much attention in the last 
few years due to it's necessity during modem warfighting, and it's unavoidable 
inherent dangers. Clearing the battlefield of Unexploded Ordnance (UXO) is a 
formidable task that presently requires the risk of human life. Future strategy calls 
for the use of a fleet of small, inexpensive, but very capable robots to clear the 
battlefield of all Unexploded Ordnance. The Navy's Explosive Ordnance Disposal 
Technical Center has developed a "BUGS" Basic UXO Gathering System in order 
to examine such strategy. In support of this effort, simulations are being 
conducted to examine the effects of navigation, control schemes, and terrain 
characteristics on battlefield clearance operations. 
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I. INTRODUCTION 


A. THE PROBLEM 

The problem of minefield clearance following dispersion by some type of air 
delivery system is a challenging task. Hundreds of submunitions can be randomly 
distributed over a sizeable area in seconds by one air weapon. The Navy's Tomahawk 
Missile System can deliver hundreds of bomblet submunitions over an area the size of a 
football field in a matter of seconds. Assuming a small percentage dud rate, this could still 
leave tens of unexploded submunitions from one missile. Naturally, from multiple 
Tomahawk missions there could be thousands of unexploded summations left on the 
battlefield. 

Current battlefield clearance techniques call for manned squads to identify, carry 
away, or blow in place unexploded ordnance (UXO). Because of the inherent danger of 
these operations, serious injury and loss of life are sometimes the product of battlefield 
clearance. For example, during the Gulf War both the Army and Marines lost personnel 
due to submunition clearance operations. This alone indicates the desirability of an 
autonomous submunition clearance system that requires no human presence on the field 
during clearing operations. 

B. THE CHALLENGE, AND CURRENT ISSUES 

The underlying challenge is to safely and effectively clear the battlefield of 
unexploded ordnance using small and inexpensive robots, reducing human casualties. This 
challenge has recently been addressed by The Navy's Explosive Ordnance Disposal (EOD) 
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unexploded ordnance using small and inexpensive robots, reducing human casualties. This 
challenge has recently been addressed by The Navy's Explosive Ordnance Disposal (EOD) 
Community. As a result, it is believed that small robotic systems will be used in future 
battlefield clearance operations. However, this problem is not one that is easily solved. The 
use of robots requires sophisticated sensors for munition detection and obstacle avoidance, 
not to mention some type of precise navigation system. Once the UXO has been detected 
it must then be approached, picked up, neutralized, and then safely removed to a disposal 
location. In addition, terrain characteristics need to be considered. Terrain characteristics 
play a very important role in clearance operations. Wheel slip due to muddy, uneven, and 
rough terrain can greatly reduce clearance time and pose problems for control algorithms. 
It is very apparent that these operations are very dangerous, and a sophisticated robotic 
system can easily be lost or severely damaged. If the cost of these robotic systems can be 
minimized to a level that would be cost effective to mass produce while taking into account 
the subsequent loss of assets during clearing operations, this problem would be well on its 
way to being solved. Work is in progress at NAVEODTECHDIV to develop a system of 
radio controlled teloperated vehicles known as RECORM, to provide sophisticated 
reconnaissance in EOD clearance scenarios. This platform would have the ability to provide 
video images of the battlefield to a remote operator who could then identify UXOs for 
clearance. It is believed a less expensive and capable version, denoted "BUGS" (Basic 
Unexploded Ordnance Gathering System), should be developed to do actual ordnance 
handling, or be equipped with Blow In Place (BIP) counter charges. The BUGS platform 
should be inexpensive enough to account for the occasional loss of assets due to munition 
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mine field and UXO clearance environments to establish their effectiveness and primary 
operating parameters. This work examines the performance of such robotic systems by 
simulating UXO gathering operations using SIMULINK as the primary modeling tool. 

C. THESIS SCOPE 

The purpose of this thesis is as follows: 

1. Build a real-time computer model of a "BUGS" vehicle that accurately simulates 
dynamic and kinematic performance in UXO clearance operations (using SIMULINK). 

2. Develop a mission / vehicle controller (using petri net methodology to model the 
mission control) and develop its interfaces within the SIMULINK environment. 

3. E xamin e higher level hybrid control scheme effectiveness in modeling robotic 

vehicle performance. 

4. Examine "BUGS" vehicle performance in ideal conditions (perfect navigation/no 
wheel slip) and with slip induced by varying terrain characteristics . 

If a vehicle is not equipped with a reasonably precise navigation system and has a 
high degree of wheel slip over rough terrain, it is expected that there will be a substantial 
degradation in mission effectiveness. The key concern of this work is to examine the effects 
of wheel slip and non-perfect navigation on clearance operations. 
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II. MODERN AUTONOMOUS ROBOTIC LAND VEHICLE TECHNOLOGY 


A. HISTORY 

There has been study and experimentation in the area of autonomous robotic 
vehicles for the past few decades. With expanding technology in electronic circuitry and 
devices, autonomous robots are becoming more alluring to government and industry as a 
way to accomplish dangerous and tedious tasks. Robotic vehicles have been designed in 
many shapes and forms, depending on their intended application. Mobile tracked vehicles 
have been popular for military use as tanks and personnel carriers. Tracks are effective on 
the battlefield because they can travel over rough terrain and have a near zero turning radius. 
Conversely, walking machines, going back to the 1960’s, have the advantage of a small 
footprint, decreasing the chance of inadvertently detonating ordnance during clearance 
operations. Even though walking vehicles offer many advantages, integrating computer 
hardware and software with the additional complex mechanical structure is very costly. 
Conceptually, it is easier to integrate computers and machinery on wheeled and tracked 
vehicles. 

B. CURRENT TECHNOLOGY 

Numerous vehicle concepts are being researched by groups such as ARPA. NASA, 
and the United States Army and Navy. They are categorized by their propulsion means (i.e., 
wheeled,walking, or tracked). They are also categorized by there intended environmental 
use (i.e., land based or surf zone). 
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1. Tracked Vehicles 


One surf zone tracked vehicle currently under development is the "Lemming", 
manufactured by Foster Miller Inc., shown in Figure 2.1. This is an example of a relatively 
inexpensive autonomous vehicle for mine countermeasures that carries an internal explosive 
charge, and is capable of random search operations. It uses onboard magnetic sensors to 
detect the mine or the UXO. Once UXO detection has occurred, an explosive charge is 
placed next to the target to be detonated at a later time. In the minefield scenario, the 
lemming would park itself next to the mine and wait for the self detonation signal. The 
"Lemming" has two tactile sensors mounted on the left and right sides (front) to detect 
objects or potential obstacles. Vibration signatures received by the tactile sensor determine 
the material characteristic of the object (ie: metal, rock, or plastic) [Ref.l], 

A second tracked vehicle currently under development is the "Fetch" vehicle, 
designed by IS Robotics, shown in Figure 2.2. This autonomous robot is equipped with 
IR sensors to detect obstacles, and magnetic sensors underneath to detect munitions. Once 
the munition is detected, the carrier arm (with attached magnet) is lowered to pick it up. The 
munition is then taken the disposal location. The "Fetch" vehicle uses a GPS Navigation 
System for 0.2 centimeter navigation accuracy. 

2. Walking Vehicles 

An example of a walking machine is the "Hermes Robot" from IS Robotics. This 
vehicle is shown in Figure 2.3. Hermes is a compact, walking research robot intended for 
exploration of small environments. Its legged mobility design allows it to sense the terrain 
as well as detect obstacles in itr path. Sensors included in this robot are: proximity IR for 
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navigation, a pitch and roll inclinometer, and whiskers to detect oncoming obstacles.[Ref 

2 ] 

3. Wheeled Vehicles 

Wheeled robots currently under development include the "RECORM" and the 
"Micro Rover" vehicles, the latter of which is shown in Figure 2.4. The "RECORM" 
(Remote Controlled Reconnaissance Monitor) by Navy EODTECHDIV, is designed to 
provide remote monitoring capability or site survey of hazardous environments. It can be 
controlled by fiber optics or RF link. The "Micro Rover" by Draper Laboratories, is 
designed for high speed munition clearance. It is outfitted with sonar and laser sensors for 
detection. It also features a custom robotic arm for munition handling. 

The Swiss Federal Institute of Technology has developed an autonomous robotic 
land vehicle called the " PREMEX-BE" (PErsonal Mine Explorer"). This vehicle, shown 
in Figure 2.5, is equipped with a sensor on an extended arm which is connected to a wheeled 
control package. Direct current motors operate large wheels in an alternating sequence, 
producing a sweeping motion of the sensor. 

The future of innovative systems for mine countermeasures on land lies in the 
coordinated use of multiples of small robots - each being a very low cost item - but 
controlled and organized in such a way that human intervention with the deadly item is not 
direct. 
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Figure 2.1 Foster Miller Inc “LEMMING” Vehicle 
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Figure 2.2 IS Robtics “Pebbles” Vehicle 
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Figure 2.4 Draper Laboratories “MICRO-ROVER” 
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Figure 2.5 SWISS Federal Institute of Technolog}' “PEMEX-BE” Vehicle 
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III. VEHICLE MODEL DESIGN USING MATLAB/SIMULINK 


A. MODELING TOOLS 

1. MATLAB 

Linear control system analysis and design begins with mathematical models of 
real systems. These models are representations of such items as machinery, electrical 
circuits, and aircraft, used to study the dynamic response of real systems. MATLAB 
(MATrix LABoratory) is a mathematically oriented computer program used for science 
and engineering applications. MATLAB uses models in the form of continous state 
differential or difference equations that represent the evolving changes in state as a 
response to input excitation [Ref 3]. Linear systems can be expressed by ffequecy 
domain transfer functions or time domain state-space equations, allowing "classical" and 
"modem" control system analysis and design analysis techniques. Either model form can 
be expressed in continuous (analog) or discrete-time (digital) form. Since the use of 
digital microprocessors are now common control elements, it is the later that has found 
significant recent importance. Non-linear systems where the time derivatives of stste are 
nonlinear functions of the state itself, can be simulated using numerical integration of the 
nonlinear differential equations of the model. Linear state-space system models are 
particularly well suited to MATAB since they are matrix based, although nonlinear 
simulations are also easily conducted in the Matlab environment using the graphically 
based SIMULINK features. 
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2. SIMULINK 


SIMULINK is a MATLAB graphically based software package for modeling, 
simulating, and analyzing dynamical systems. It supports linear and nonlinear systems 
modeled in continuous time, sampled time, or a hybrid of the two. The SIMULINK 
environment provides a graphical user interface (GUI) for building models in the form of 
block diagrams that are easily modified and saved. It is equipped with a comprehensive 
block library of sinks, sources, linear and nonlinear components, and connectors. After 
the model is defined, a simulation can be executed using a number of integration 
methods. 

B. CONTROL SYSTEMS 

1. Discrete-Time Control Systems 

In recent years, because of the expended capabilities of the microprocessor, there 
has been an increase in the use of digital controllers for control system implementation. 
The application of digital control has made possible "intelligent" motion in industrial 
robots, the optimization of fuel economy in automobiles, and refinements in the 
operation of household appliances such as microwave ovens. Decision-making 
capability and flexibility in control programming are major advantages of digital control 
systems. Discrete-time control systems are control systems in which one or more 
continuous time variables can be sampled / or changed at discrete instants of time. These 
instants are specified times at which some measurement is taken. The time interval 
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between consecutive discrete intervals is taken to be very short so that the data between 
the time interval can be approximated by simple interpolation algorithms. Signals from 
discrete-time control systems are in sampled-data (digital) form. Figure 3.1 shows a 
discrete time signal. If a digital computer is involved in a control system as a digital 
controller, sampled data must be converted into a finite precision digital data format 
(usually 12 /14 / 16 bit binary format). The discrete-time controller samples the 
continuous-time signal at the discrete time points. The term "discretization" rather than 
"sampling" is frequently used, although both mean basically the same thing. The stability 
requirements and design of discrete time digital control algorithms are well known 
(Ogata, 1996), and it is also well known that the control parameters depend on the update 
rate (rate at which sensory data are sampled). 

2. Continuous-Time / Discrete Time / Discrete State Control Systems 

Continuous-time systems may be described by differential equations as opposed 
to the use of difference equations with discrete-time systems. Continuous-time systems 
compute the value of the derivative of the state vector at the current time which is always 
assumed to be a continuous function of itme, rather than the value of the state vector at 
the next sample time, which discrete-time state space equations compute. A 
continuous-time signal is defined over a continuous range of time. The amplitude may 
assume a continuous range of values or a finite set of values. Figure 3.2 shows an 
example of a continuous time signal. Some applications of continuous-time controllers 
include, motor speed governors, cruise control systems, and home heating systems. A 
hybrid system is one where some states are continuous while othere such as the set of 
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mission states (for example, search mode, transit mode, pick up, etc.) are discrete, taking 
essentially binary values to determine if any one or another is active or not. 


C. VEHICLE MODEL 
1. Components 

The SIMULINK "BUGS" model is a "hybrid", state-space, discrete event 
controller for a single vehicle. Given target location and commanded speed, it uses a line 
of sight guidance control scheme to transitthe vehicle to the goal point. A full block 
diagram model can be seen in Appendix A, along with a vehicle profile/equation sheet. 
The model is sub-divided into three component areas: 

a. Maneuvering and Drive Component 
The maneuvering and drive component shown in Figure 3.3, takes 
commanded vehicle velocity and commanded turn rate input from the controller and 
computes commanded wheel speed. This commanded wheel speed is then input into a 
difference equation represented in SIMULINK by a discrete-time (z transform) block 
diagram, where the updated wheel speed is computed. Individual track speed and 
overall vehicle speed is then computed from the wheel speed input. The following 
equations apply; 

Commanded Wheel Speed # 1: wlc(k) = ucom(k)/d + rcom(k) *D/d 
Commanded Wheel Speed # 2: w2c(k) = ucom(k)/d - rcom(k) *D/d 
Wheel Speed# 1 w,(k+l) = a*wl(k) + (l-a)*wlc(k) 

Wheel Speed#2: w2(k+l) = a*w2(k) + (l-a)*w>2c(k) 
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Track Speed #1: 


vl(k)=wl(k)*D/d 


Track Speed #2: v2(k) = w2(k) *D/d 

Vehicle Speed: u(k) - 0.5*(vl(k) - v2(k)) 

where ucom = commanded velocity (meters/sec) 
rcom = commanded turn rate (rad/sec) 

D = vehicle diameter (meters) 
d = wheel diameter (meters) 
a = motor lag constant 

b. Heading and Position (Navigation) Component 

The heading component shown in Figure 3.4, takes inputs of turn rate 
and current heading and computes an updated heading. This component also uses a 
difference equation, represented in SIMULINK by a discrete-time (z transform )block 
diagram for computation. The position component shown in Figure 3-4, takes inputs of 
current position, vehicle speed, and heading to compute updated X & Y positions. 

Again, this also uses a difference equation and is represented in SIMULINK by a 
discrete-time (z transform) block diagram. The following equations are used for this 
component; 

Heading: x P(k+l) = 'Y(k) + dt*r(k) 

X coordinate: X(k+1) =X(k) + u(k)*cos('¥(k)) 

Y coordinate: Y(k+1) = Y(k) + u(k)*sin('Y (k)) 

where r(k) = current turn rate (rad/sec) 
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c. Controller Component 

The controller shown in Figure 3.5, is the central processing element of 
the "BUGS" model. It is designed as finite state automaton. The controller takes 21 data 
inputs and multiplexes them into a vector which is input into a MATLAB file 
representing the mission control logic for the vehicle. The MATLAB file reads in 
position, heading, time, dynamic states, and transition states, then computes updated 
values based on a series of'transition’ statements. These updated values are put into a 
vector and de-multiplexed back into the system. The state logic diagram shown in 
Figure 3.6, represents the functional behavior which the model follows to determine the 
current mission state, and give commands for the next. 
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Discrete Time Signal 



Figure 3.1 Discrete Time Signal 
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Figure 3.3 Block Diagram “Maneuvering and Drive Component 
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Figure 3.4 Block Diagram “ Heading and Position Component” 
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Figure 3.5 Block Diagram “Controller” 
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Figure 3.6 State Space Logic Diagram “Petri Net” 










IV. SIMULATIONS 


A. SIMULATION SET UP AND PARAMETERS 

The simulations conducted were designed to evaluate the effect of vehicle 
performance in UXO clearance operations under conditions of high slip (caused by rough 
terrain characteristics) and navigation error. Terrain characteristics such as topography, 
rocks, sand, mud, and other natural obstacles influence the vehicles ability to maintain a 
commanded course during UXO clearance operations. Slip will be modeled using a 
MATLAB uniformly distributed (0.0 to 1.0) random number generator. The code and 
associated block diagram configuration are shown in Appendix A. The slip coefficient 
(o) is multiplied by the current track speed, then this quantity is subtracted from the 
velocity to give actual track speed over ground. Each track has it’s own dedicated slip 
coefficient generator to model independent terrain variations. Current commercial GPS 
navigation systems provide navigation with 2 centimeter precision (perfect navigation in 
the context of this thesis). Navigation error is modeled by a normally distributed (0.0 to 
1.0) random white noise generator from the SIMULINK source file. The white noise 
signal (error) is then passed through a first order “coloration” filter to provide temporal 
correlation characteristics where it is smoothed out and added to the current GPS location 
output to give sensed location. For simulation purposes, a 14 centimeter standard 
deviation navigation error which is realisically achieved in at least one differential gps 
system in use (Premier) is assumed. The block diagram configuration is shown in 
Appendix A. 
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The following equations will be used in the simulation: 

Track # 1 Slip Velocity vsl = vl(k) - vl(k)*al 
Track # 2 Slip Coefficient vs2 = v2(k) - v2(k) *o2 
X[(k +1) dt] = [exp(dt)]*X[k dt] + [l-exp(dth)]*pl[k dt) 

Y[(k + 1) dt] = [exp(dt/x)]*Y[k dt] + [1 - exp(dt/x)]*p2[k dt) 
where, a = slip coefficient 

dt= 1 
t = 106 

p = navigation error noise coefficient 

B. SIMULATION SCENARIOS 
1. No Slip with Perfect Navigation 

a. Path Deviation Test (Point to Point) 

This simulation has been conducted for target distances of 10, 20, and 30 
meters. Starting from position (0,0), the vehicle is sent to a target 10 meters away to 
position (10,10). This scenario, because of the assumed randomness in errors and 
slippage, was run 10 times, with each scenario path recorded and stored in a data file. 
The 10 paths were then super-imposed and plotted against the ideal path on a XY graph. 
The lateral path deviation was calculated from the recorded path data using MATLAB. 
The following data and equations will be used to compute standard deviation. 
x() = x path coordinates for run () 
y() = y path coordinates for run ( ) 
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Xi = [xl; x2; x3; x4; x5; x6; x7; x8; x9; xlO] 

Yi = [yl; y2; y3; y4; y5; y6; y7; y8; y9; ylO] 

Yi = 1AT.2*Xi - 1/f2 * Yi 

a (dev) = std(Yj) %[standard deviation of £i (MATLAB function)] 

b. Clearance Test 

For this scenario, five pre-designated UXO targets were programmed into the 
vehicle. Starting from location (0,0), the vehicle assignment was to go to the UXO, 
perform a pickup maneuver, and carry it away to the disposal location (0,0). This was 
done until all UXOs were cleared from the field. A time history was recorded and the 
vehicle path plotted. 

2.No Slip with Navigation Error 

a. Path Deviation Test (Point to Point) 

This simulation was conducted for target distances of 10, 20, and 30 meters. 
Starting from position (0,0), the vehicle was sent to a target 10 meters away to position 
(10,10). This scenario was run 10 times, with each scenario path recorded and stored in 
a data file. The 10 paths were super-imposed and plotted against the ideal path on a XY 
graph. The lateral path deviation was calculated from the recorded path data using 
MATLAB. 

b. Clearance Test 

For this scenario, five pre-designated UXO targets were programmed into the 
vehicle. Starting from location (0,0), the vehicle assignment was to go to the UXO. 
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perform a pickup maneuver, and carry it away to the disposal location (0,0). This was 
done until all UXOs were cleared from the field. 

3. Slip with Perfect Navigation 

a. Path Deviation Test (Point to Point) 

This simulation was conducted for target distances of 10, 20, and 30 meters. 
Starting from position (0,0), the vehicle was sent to a target 10 meters away to position 
(10,10). This scenario was run 10 times, with each scenario path recorded and stored in 
a data file. 

b. Clearance Test 

For this scenario, five pre-designated UXO targets will be programmed into 
the vehicle. Starting from location (0,0), the vehicle assignment will be to go to the 
UXO, perform a pickup maneuver, and carry it away to the disposal location (0.0). This 
will be done until all UXOs have been cleared from the field. A time history will be 
recorded and the vehicle path will be plotted on an XY graph. 

4. Slip with Navigation Error 

The identical scenario with both wheel slip and navigational error was run. Each path 
was recorded and super-imposed to show the path randomness caused by slip and navigation 
error. These result were compared and analyzed for path deviation and clearance time. 
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V. DISCUSSION OF SIMULATION RESULTS 

A. NO WHEEL SLIP WITH PERFECT NAVIGATION 
1. Clearance Time (Ordnance Clearing Scenario) 

Five pre-assigned UXO targets were programmed into the vehicle model. The 
vehicle was then sent out to clear the field while time and vehicle path were recorded. As 
expected, path deviation was non-existent during this scenario. Figure 5.1 shows the 
vehicle path for this simulation. The time it took to find and clear all five assigned 
targets was 18.7 minutes. 

B. NO WHEEL SLIP WITH NAVIGATION ERROR 
1. Path Deviation (Point to Point Transit) 

The point to point navigation test was conducted to examine vehicle path lateral 
deviation due to a 14 centimeter navigation error. Tests were conducted at 10, 20, 30 
meters. At each distance, 10 scenarios were run and their respective path tracks stored in 
a data file. The 10 tracks were then super-imposed and plotted against the ideal path as 
indicated with asterisks. On the basis of the ten experiments, mean and standard 
deviation cross track errors were computed and the following results were calculated: 

Distance (meters) Maximum Lateral Path Deviation (meters) 

10 0.1499 

20 0.1149 

30 0.0975 

Path deviation due to navigation error alone was very low. As distance increased, the 
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path deviation decreased. Even at 10 meters, the deviation was within the 14 centimeter 
navigation error range. These results are shown in Figures 5.2, 5.3, and 5.4 respectively. 
2. Clearance Time (Ordnance Clearing Scenario) 

Five pre-assigned UXO targets were programmed into the vehicle model. The 
vehicle was then sent out to clear the field while time and vehicle path were recorded. As 
expected, path deviation was non-existent during this scenario. Figure 5.5 shows the 
vehicle path for this simulation. Clearance time was 18.83 minutes. This took just 0.13 
minutes longer than the no slip-perfect navigation case, indicating that the vehicle control 
system accomodates navigational errors well. 

C. WHEEL SLIP WITH PERFECT NAVIGATION 
1. Path Deviation (Point to Point Transit) 

The point to point navigation test was conducted to examine vehicle path lateral 
deviation due to wheel slip alone. Tests were conducted at 10, 20, 30 meters. At each 
distance, 10 scenarios were run and their respective path tracks stored in a data file. The 
10 tracks were then super-imposed and plotted against the ideal path as indicated with 
asterisks. The following results were calculated: 

Distance ('meters') Maximum Lateral Path Deviation fmeters) 

10 0.5084 

20 0.6115 

30 0.7451 

Path deviation due to slip alone was considerably higher than the two previous cases. 
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As path distance increased from 10 to 30 meters, lateral deviation increase by almost a 
factor of 0.1 meters. The results are shown in figures 5.6, 5.7, and 5.8 respectively. 

2. Clearance Time (Ordnance Clearing Scenario) 

Five pre-assigned UXO targets were programmed into the vehicle model. The 
vehicle was then sent out to clear the field while time and vehicle path were recorded. As 
expected, path deviation was non-existent during this scenario. Figure 5.9 shows the 
vehicle path for this simulation. Clearance time was 37 minutes. This is about twice the 
time it took for the no slip-navigation error case. As can be seen, clearance time was 
greatly effected by the introduced slip - mostly because of the effect on average forward 
speed reduction. 

D. WHEEL SLIP WITH NAVIGATION ERROR 

1. Path Deviation (Point to Point Transit) 

The point to point navigation test was conducted to examine vehicle path lateral 
deviation due to wheel slip and a 14 centimeter navigation error. Tests were conducted at 
10, 20, 30 meters. At each distance, 10 scenarios were run and their respective path tracks 
stored in a data file. The 10 tracks were then super-imposed and plotted against the ideal 
path as indicated with asterisks. The following results were calculated: 

Distance (meters') Maximum Lateral Path Deviation (meters) 

10 0.4208 

20 0.6093 

30 1.2 
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Path deviation due to slip alone was considerably higher than the two previous cases. 
As path distance increased from 10 to 30 meters, lateral deviation increased. These 
results are very consistent with the slip-perfect navigation case. The results are shown in 
figures 5.10, 5.11, and 5.12 respectively. 

2. Clearance Time (Ordnance Clearing Scenario) 

Five pre-assigned UXO targets were programmed into the vehicle model. The 
vehicle was then sent out to clear the field while time and vehicle path were recorded. As 
expected, path deviation was non-existent during this scenario. Figure 5.13 shows the 
vehicle path for this simulation. Clearance time was 37.3 minutes. This took just 0.3 
minutes longer than the no slip-perfect navigation case. The introduction of navigation 
error has minimal effect on clearance time. 
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(No Slip / Perfect Navigation) 



Figure 5.1 No Slip with Perfect Navigation 
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Path Deviation (No Slip w/ Navigation Error) 



34 



















Path Deviation (No Slip w/ Navigation Error) 



Figure 5.3 Path Deviation for 20 meters “No Slip with Navigation Error’ 
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Figure 5.7 Path Deviation for 20 meters “Slip with Perfect Navigation” 
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Figure 5.8 Path Deviation for 30 meters “Slip with Perfect Navigation” 
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(Slip w/ Perfect Navigation) 
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Figure 5.10 Path Deviation for 10 meters “Slip with Navigation Error” 
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Figure 5.11 Path Deviation for 20 meters “Slip with Navigation Error” 
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VI. CONCLUSIONS 


The primary purpose of this thesis was to develop a computer model to simulate the 
dynamic and kinematic characteristics of a small tracked robotic vehicle used for unexploded 
ordnance (UXO) gathering operations. After model development, the secondary purpose 
was to examine vehicle performance in UXO gathering operations under the influence of 
track slip (due to terrain characteristics) and navigational error. It was found that vehicle 
performance could reasonably be modeled using a discrete time / discrete event state space 
control scheme. Using SIMULINK as a modeling tool, discrete time state space equations 
can be modeled with block diagrams. Discrete state modeling including the state transition 
logic is built into a separate file, linked to the main system’s blocks through a multiple xing 
/ demultiplexing of the discrete state signals. Multiple point to point scenarios run under 
varying conditions (ie; no slip-perfect navigation, no slip-navigation error, slip-perfect 
navigation, and slip-navigation error) demonstrated that vehicle performance was 
significantly reduced by track slip more than navigation error. Track slip caused a greater 
path deviation than did navigation error. In some cases, track slip caused the vehicle to 
deviate from it’s path more than twice the distance caused by realistic navigation error. 
UXO clearance scenarios also demonstrated track slip caused more of a degradation in 
performance than did navigation error. UXO clearance time doubled when track slip is 
introduced. Navigation error alone had minimal effect on clearance time compared to ideal 
conditions of no slip with perfect navigation. The speed of solution with SIMULINK is too 
slow to be generally useful in complex scenarios so one recommendation is that the auto- 
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code generation capabilities of the simulation software be used to get a C code version that 
would run many times faster. Otherwise the techniques using SIMULINK as explained here 
are convenient. 
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APPENDIX. SYSTEM DIAGRAMS AND MODELING EQUATIONS 


This Appendix contains the derived state space equations used to model vehicle 
kinematic and dynamic characteristics. Also included is a full simulink system model 
emplementing these equations with associated source codes. 
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% BUG Controller 


% Dynamic States 

% state xl: Get_First_UXO_Position 
% state x2: Nav_To_Position. 

% state x3 : Stop__Within_UXO_Proximity & Pick_Up__UXO 
% state x4: Carry_UXO_To_Disposal_Area 
% state x5: Stop & Drop_Of f__UXO 
% state x6: Receive_New_UXO_Position 
% State x7: Obstacle_Detected_Enroute_To_UXO 
% State x8: Obstacle_Avoidance_Enroute_To_UXO 
% State x9: Obstacle_Detected_Enroute_To_Drop_Pile 
% State xlO: Obstacle_Avoidance_Enroute_To_Drop_Pile 

% Transition States 
% tl: FirstJ3XO_Position_Received 

% t2 : Vehic 1 e_Within_Range_0f __UXO 

% t3: UXO_Picked_Up 

% t3: UXO_Picked__Up 

% t4: Vehicle_Within_Range_Of_Drop_Pile 

% t5: Drop_Off_Complete 

% t6: New_UXO_Position__Received 

% t7: Obstacle_Detected_Enroute_To_UXO 

% t8: Signal_To_Do_Obstaele_Avoidance_Enroute_To_UXO 

% t9: Obstacle_Clear 

% tlO: Obstacle_Detected_J2nroute_To_Drop_Pile 
% til: Signal„Do_Obstacle_AvoidanceJEnroute_To_Drop_Pile 
% tl2: Obstacle_Clear 


function [y]= bugstate(x) 

% Initial Conditions 
X=0; 

Y=0; 

psicom=0; 
psi=0; 
rcom=0; 
ucom=0; 
k=0; 
t03=0; 

10 5 = 0 ; 
t06=0; 
t08=0; 

1010 = 0 ; 
t = 0 ; 

xl=0;x2=0;x3=0;x4=0;x5=0;x6=0;x7=0;x8=0;x9=0;xl0=0; 

tl=0;t2=0;t3=0;t4=0;t5=0;t6=0;t7=0;t8=0;t9=0;tl0=0;tll=0;tl2=0; 

% Input Vector y[x] Component Designation 
Y=x(1) 

X=x(2) 
psi=x(3) 
t=x(4) 
t0=x(5) 
k=x(6) 
xl=x(7) 
x2=x(8) 
x3=x(9) 
x4=x{10) 
x5=x(11) 
x6=x(12) 
x7=x(13) 
x8=x(14} 
x9=x(15) 
xl0=x(16) 
t03=x(17) 
t05=x(18) 
t06=x(19) 
t 08 =x( 20 ) 
t010=x(21) 

targetl 

obstacles 
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if psi>2*pi 

psi=psi~2*pi; 
elseif psi<-2*pi 

psi=psi+2*pi; 

end 

end 

% Start (initial state 1} 
if t<=l 

k=l; 

ucom=.2 ; 
xl=l; 
tl=l? 

end 


% Transition State Calculations 

if x2==l & ( abs (Xd (k) -X) <= . 5 Sc abs(Yd(k)-Y)<=.5 ) 
t2 = l; 

end 

if (atan2(Y-Yobs,X-Xobs)<=(psi+pi/4 | psi-pi/4)) & ((abs(X-Xobs)<=.5) & (abs(Y-Yobs)<=. 
5) ) 

t7 = l; 

end 

if x3==l Sc t>= (t03 + 10) 
t3 = l ; 

end 

if x4==l & (abs(0—X)<=.5 & abs(0-Y)<=.5) 
t4 = l ; 

end 

if x5==l & t>=t05+10 
t5=l; 

end 

if x6==l Sc t>=t06 + 10 
16 = 1 ; 

end 

if x2==l Sc (atan2(Y-Yobs,X-Xobs)<=(psi+pi/4 | psi-pi/4)) & ((abs(X-Xobs)<=.5) & (abs(Y- 
Yobs)<=.5)) 

t7 = l; 

end 

if x7==l Sc ucom= = 0 
18 = 1; 

end 

if x8==l Sc t>=t08+25 
t9=l; 

end 

if x4==l 5c (atan2(Y-Yobs,X-Xobs)<=(psi+pi/4 | psi-pi/4)) & ((abs(X-Xobs)<=.5) & (abs(Y- 
Yobs)<= . 5)) 

tl0=l; 

end 

if x9==l Sc ucom==0 
111 = 1 ; 

end 

if xl0 = = l Sc t> = tl0 + 25 
t!2=l; 

end 
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t08=0; 

psicom=atan2 (Yd(k) -Y,Xd(k) -X) ; 
error=(psicom-psi); 
rcom=error*.3; 
ucom=.2; 

end 


% Stop_And_Pickup (state 3) 

if x2==l Sc t2==l 
x3 = 1 ; 
t03 = t 
x2=0; 
t2=0; 
ucom=0 ; 

end 


% CarryJTo_Drop_Off_Pile (state 4) 

if (x3==l & t3==l) | (xlO==l Sc tl2==l) | (x4==l) 

x4=l? 
x3 = 0; 
t3=0; 
t03=0; 
ucom=.2; 

psicom=atan2(0-Y, 0-X) 
error=(psicom-psi); 
rcom=error*.3 ; 

end 


% Stop_And_Drop_Off (state 5) 

if x4==l Sc t4==l 
x5 = l; 
x4 = 0; 
t4=0;' 
t05=t; 
ucom=0; 

end 


% Get_New_UXO_Position (state 6) 

if x5==l & t5==l 
k=k+l; 
x6 = l ; 
t6=l; 
x5 = 0 ; 
t5 = 0 ; 
t05=0; 
t06=t; 
ucom=0; 

end 


% Obstacle__Detected__Enroute_To_UXO (state 7) 

if x2==l Sc t7==l 
x7 = 1; 
t7 = 0; 
x2 = 0; 
ucom=0; 
t 08 =t; 

psicom=psi+pi 
errors(psicom-psi); 
rcom=error*.3; 
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end 


% Obstacle_Avoidance (state 8) 

if X 7==l Sc t8==l | x8==l 
x8=l; 
x7=0 ? 
t8=°; 
ucom=.08; 

end- 

if x8==l & t>=t08+25 
ucom=0; 
psi=psi-pi/2; 
psicom=psi; 

end 


% Obstac1e_Detected_Enroute_To_Disposal_Area (state 9) 

if x4==l Sc tl0==l 
x9=l; 
tl0=0; 
x4=0 ; 
ucom=0; 

end 


% Obstacle_Avoidance (state 10) 

if x9==l Sc tll==l 
xl0=l; 
t010=t; 
x9=0; 
tll=0; 

psi=psi+pi/2; 
psicom=psi; 
ucom=.08; 


end 

if xl0==l 


& t>=t010+25 


ucom=0 ? 
psi=psi-pi/2; 
psicom=psi; 


end 


state= (xl;x2;x3;x4;x5;x6;x7;x8;x9;xlO] 

*^”S,uSTS;^5.-2f3“4S^; J .7;xS,, 9 ,«10, t 03 !t 05.tO«; t 08;t0 1 0] 
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VEHICLE MODELING EQUATIONS 

Commanded Wheel Speed # 1 wlc(k) = ucom(k)/d + rcom(k)*D/d/2 
Commanded Wheel Speed # 2 w2c(k) = ucom(k)/d - rcom(k)*D/d/2 
Wheel Speed # 1 wl(k+l) = a*wl(k) + (l-a)*wlc(k) 

Wheel Speed # 2 w2(k+l) = a*w2(k) + (l-a)*w2c(k) 

Track Speed #1 vl(k) = wl(k)*D/d 
Track Speed #2 v2(k) = w2(k)*D/d 
Vehicle Speed u(k) = 0.5*(vl(k) + v2(k)) 

Turn Rate r(k) = 0.5*(vl-v2) 

Heading psi(k+l) = psi(k) + r(k)*dt 
X coordinate X(k+1) = X(k) + u(k)*(sin(psi))*dt 
Y coordinate Y(k+1) = Y(k) + u(k)*(cos(psi))*dt 
where, 

ucom = commanded velocity (meters/sec) rcom = commanded turn rate (rad/sec) 
D = vehicle diameter (meters) d = wheel diameter (meters) 

a = motor lag constant 
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